/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2008. All Rights Reserved.                             */
/* Open Source Software - may be modified and shared by FRC teams. The code   */
/* must be accompanied by the FIRST BSD license file in the root directory of */
/* the project.                                                               */
/*----------------------------------------------------------------------------*/
//
package edu.wpi.first.wpilibj.templates;


import edu.wpi.first.wpilibj.IterativeRobot;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.RobotDrive;


// Vision
import edu.wpi.first.wpilibj.camera.AxisCamera;
import edu.wpi.first.wpilibj.camera.AxisCameraException;
import edu.wpi.first.wpilibj.image.NIVisionException;
import edu.wpi.first.wpilibj.image.ColorImage;
import edu.wpi.first.wpilibj.image.MonoImage;
import edu.wpi.first.wpilibj.image.EllipseDescriptor;
import edu.wpi.first.wpilibj.image.EllipseMatch;



/**
 * The VM is configured to automatically run this class, and to call the
 * functions corresponding to each mode, as described in the SimpleRobot
 * documentation. If you change the name of this class or the package after
 * creating this project, you must also update the manifest file in the resource
 * directory.
 */
public class Robot extends IterativeRobot {
    Joystick   stickLeft  = new Joystick(1);
    Joystick   stickRight = new Joystick(2);
    RobotDrive drive      = new RobotDrive(1, 2, 3, 4);
    RobotVision vision    = RobotVision.getInstance();

    public void robotInit()
    {

    }

    public void disabledInit()
    {

    }

    public void disabledPeriodic()
    {

    }
    
    public void disabledContinuous()
    {

    }

    public void autonomousInit()
    {
        
    }
    
    public void autonomousPeriodic()
    {
        
    }
        
    public void autonomousContinuous()
    {
        
    }

    public void teleopInit()
    {

    }
    public void teleopPeriodic()
    {
        drive.tankDrive(stickLeft, stickRight);

        vision.getTarget();
    }

    public void teleopContinuous()
    {

    }
}
